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TITLE OF THE INVENTION 

APPARATUS, METHOD OR SYSTEM FOR CONTROLLING MOBILE BODY 



BACKGROUND OF THE INVENTION 
5 [0001] 

The present invention relates to an apparatus and a method 
of controlling a mobile body, and a mobile body system. 
[0002] 

A synchronous motor that uses a permanent magnet to create 
10 a magnetic field has recently been applied to various mechanical 
apparatuses for the purpose of reducing the size of the 
apparatuses and increasing efficiency. 
[0003] 

However, in order to control rotation of a synchronous 
15 motor, it is necessary to recognize the position of a rotor, 
i.e. a magnetic pole position, and to control power supply. 
To do so, means for detecting a magnetic pole position is required. 
For example, the prior art disclosed in Japanese Application 
Patent Laid-open Publication No. Hei 10-80188 requires a 
20 magnetic pole position sensor. This kind of magnetic pole 
position detector requires effort to align a motor shaft with 
an encoder shaft or complicated, painstaking maintenance. 
[0004] 

To eliminate such problems, there have been some studies 
25 of technology to control a magnetic pole position of a 

synchronous motor without using a sensor, as described in 
Proceedings of the 2000 Japan Industry Applications Society 
Conference "No. 97: A New Position Sensor-less Control of 
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Permanent Magnet Synchronous Motor using Direct Position Error 
Estimation, Pages 963-966. 
[0005] 

Figure 10 illustrates an example of a permanent magnet-type 
5 synchronous motor control system in accordance with the 

magnetic pole position sensor-less control technology. This 
control system comprises a first coordinate transformer 3a 
which obtains detected current values Id and Iq of a rotating 
coordinate system by inputting motor phase detected current 

10 values Iu and Iw detected by a current detector, an axis error 
estimator 3b which obtains an error A6 between a magnetic pole 
position 6m of a motor rotor and an estimated magnetic pole 
position value 9mc by inputting the detected current values 
Id and Iq, a motor speed computing element 3c which obtains 

15 estimated motor speed com by inputting the error Ae, a rotor 
position estimator 3d which obtains an estimated magnetic pole 
position value emc by inputting the estimated motor speed com, 
a current command computing element 3e which obtains current 
command values Id* and Iq* by inputting the estimated motor 

20 speed com and a motor speed command value com*, an output voltage 
command computing element 3f which obtains output voltage 
commands Vd* and Vq* by inputting the current command values 
Id* and Iq*, and a second coordinate transformer 3 g which obtains 
drive unit drive commands Vu* , Vv* and Vw* for driving the 

25 motor by inputting the output voltage commands Vd* and Vq*. 

This example uses an estimated value 0mc obtained by a rotor 
position estimator 3d as a magnetic pole position 6m so that 
a permanent magnet-type synchronous motor can be driven without 



requiring a magnetic pole position sensor. 
[0006] 

Technology mentioned above has made it possible to rotate 
a synchronous motor without requiring a detector which detects 
a magnetic pole position of the rotor. 

[0007] 

For example, in Japanese Application Patent Laid-Open 
Publication No. 2000-78878, an example of an actual mobile 
body system is shown that applies the sensor-less control 
technology for controlling a magnetic pole position of a 
synchronous motor. However, this example requires an encoder 
as a mobile body position detector so that the mobile body 
system itself can be controlled to stop at a fixed point. 

SUMMARY OF THE INVENTION 
[0008] 

Problems still remain when a mobile body position detector 
is required: difficulties inmounting the detector , unnecessary 
occupation of space, and adverse effects on the system's 
reliability. 
[0009] 

The main purpose of the present invention is to control 
the position of a mobile body without using a position detector 
as to a mobile body system that uses a synchronous motor as 
a driving power source. 
[0010] 

The above problems can be solved by estimating a magnetic 
pole position of a rotor of a synchronous motor based on 



electrical quantities in relation to electric power supplied 
to the synchronous motor and further by estimating the mobile 
body position on the basis of the estimated magnetic pole 
position. Here, electrical quantities in relation to electric 
5 power supplied to a synchronous motor are currents or voltages 
that are supplied to the synchronous motor. 
[0011] 

This means makes it possible to control the position of 
a mobile body without using a mobile body position detector 
10 because the position of a mobile body is estimated based on 
a magnetic pole position of the rotor of the synchronous motor 
according to electrical quantities. Further, this means 
preferably makes it possible to highly accurately control the 
position by correcting an estimated position of the mobile 
15 body based on absolute position information of the mobile body. 
[0012] 

A mobile body can be any of an elevator car, elevator counter 
weight, elevator door, escalator step, rolling stock, and so 
on. A synchronous motor can be any of a permanent magnet-type 
2 0 synchronous motor, wire-wound synchronous motor, synchronous 
reluctance motor, and so on. 



BRIEF DESCRIPTION OF THE DRAWINGS 

Figure 1 is a mobile body system which is a first embodiment 
25 of the present invention. 

Figure 2 is a mobile body system which is a second embodiment 
of the present invention. 

Figure 3 is a mobile body system which is a third embodiment 
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of the present invention. 

Figure 4 is a mobile body system which is a fourth embodiment 
of the present invention. 

Figure 5 is a mobile body system which is a fifth embodiment 
5 of the present invention. 

Figure 6 is a mobile body system which is a sixth embodiment 
of the present invention. 

Figure 7 is a mobile body system which is a seventh 
embodiment of the present invention. 
10 Figure 8 is a mobile body system which is an eighth 

embodiment of the present invention. 

Figure 9 is a mobile body system which is a ninth embodiment 
of the present invention. 

Figure 10 is an example that shows a configuration of a 
15 synchronous motor drive control system. 



DETAILED DESCRIPTION OF THE INVENTION 
[0013] 

Figure 1 illustrates a mobile body system which is a first 
20 embodiment of the present invention. In Figure 1, there are 
shown a synchronous motor 1 which generates torque to drive 
a mobile body 4, a drive unit 2 which supplies electric power 
to the synchronous motor 1 , a controller 3 which controls the 
drive unit 2 , the mobile body 4 , and mobile body driving means 
25 5 which is mechanically connected to the synchronous motor 
1 and drives the mobile body 4 by using the torque generated 
by the synchronous motor 1 . Further, the drive unit 2 comprises 
a DC power source 201, a power converter 202 which converts 



DC power from the DC power source 201 to AC power, and a current 
detector 203 which detects current supplied to the synchronous 
motor 1 . The controller 3 comprises a rotor position estimator 
301 which estimates a magnetic pole position of a rotor of 
a synchronous motor from the current detected by the current 
detector 203 , and a drive command generator 3 02 which generates 
drive commands given to the drive unit 2 based on a magnetic 
pole position emc estimated by the rotor position estimator 
301 so that the speed of the synchronous motor 1 will approach 
a speed command torn*. Furthermore, there are shown a mobile 
body position estimator 6 which estimates the position of the 
mobile body 4 from a magnetic pole position emc estimated by 
the rotor position estimator 301, position information 
correcting means 7 which imports absolute position information 
of the mobile body 4 thereby correcting mobile body position 
information stored in the mobile body position estimator 6, 
and a motor speed command generator 8 which creates a speed 
command com* and sends it to the drive command generator 302 
so that the estimated mobile body position Xc that is obtained 
by the mobile body position estimator 6 will approach a position 
command X* of the mobile body 4 . There is also shown a position 
indicator 9 which creates position information of the mobile 
body 4 based on the estimated mobile body position Xc and displays 
the information. 
[0014] 

Next, operations of a mobile body system which is a first 
embodiment of the present invention will be described . A power 
converter 2 02 converts DC power supplied from a DC power source 
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201 to AC power according to drive commands generated by a 
drive command generator 302 and outputs the AC power to rotate 
a synchronous motor 1 . A mobile body 4 uses the synchronous 
motor 1 as a power source via drive means 5 to change its position. 
5 Further, a rotor position estimator 301 estimates a position 
9m of a rotor of the synchronous motor 1 by using an output 
of a current detector 203 and outputs the estimated quantity 
emc. Here, a variety of configurations of a controller 3 can 
be expected including a position estimation method by a rotor 
10 position estimator 301. For example, an embodiment shown in 
Figure 10 is one of those configurations. 
[0015] 

Now, a mobile body position estimator 6 will be described. 
A relationship between a rotor position em of a synchronous 

15 motor 1 and a position X of a mobile body 4 will be explained. 
Here, if the mobile body drive means 5 is a driving wheel and 
the distance the mobile body 4 travels when the driving wheel 
makes one revolution is L, the distance the mobile body 4 travels 
when the rotor of the synchronous motor 1 makes one revolution 

20 is also L. This indicates that there is a relationship between 
X and 6m as shown in the following equation. 
[0016] 

x-xo+ j 0 ^ 3 6 0Cdeg-] z~ t — -jdt 

25 

[0017] 

Here, X0 indicates the initial position of the mobile body . 
The relationship expressed by the following equation usually 



holds . 

[0018] 

0m = 6mc (2) 
Accordingly, the position X of the mobile body 4 can be 
estimated by using the estimated position 0mc output by a rotor 
position estimator 301, and the relationships expressed by 
Equations (1) and (2). Specifically, in a mobile body position 
estimator 6 , an estimated pos ition Xc can be obtained by Equation 
(3) in which a position X is replaced with an estimated mobile 
body position Xc instead of Equation (1). 
[0019] 



~t ) dt (3) 



[0020] 

As described above, this embodiment can obtain position 
information of a mobile body driven by a synchronous motor 
without employing a dedicated mobile body position detector. 
Further, the magnetic pole position of the rotor of the 
synchronous motor corresponds to the distance a mobile body 
travels. Therefore, the position of a mobile body can 
relatively easily and accurately be estimated from the 
estimated value of the magnetic pole position. 

[0021] 

Next, position information correcting means 7 will be 
described. As described above, a mobile body position 
estimator 6 estimates the position of a mobile body 4 , however, 
an error occurs between the actual mobile body position X and 
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the estimated mobile body position Xc because the relationship 
expressed by Equation ( 1 ) is destroyed due to drive means 5 
slipping or worn out. At this point, position information 
correcting means 7 imports absolute position information of 
5 a mobile body 4 and outputs information to correct mobile body 
position information stored in a mobile body position estimator 
6 . Absolute position information is input into the mobile body 
position estimator 6 by the position information correcting 
means 7. The mobile body position estimator 6 uses the newly 

10 entered absolute position information as an estimated mobile 
body position Xc. This makes it possible to correct an 
estimated position and set a correct position even though an 
error occurs between an actual position of a mobile body 4 
and an estimated position obtained by a mobile body position 

15 estimator 6. Thus, a mobile body position can be accurately 
estimated by using position information correcting means 7. 
[0022] 

Further, a motor speed command generator 8 inputs a mobile 
body position command X* and an estimated mobile body position 

20 Xc to generate a speed command com* given to a synchronous motor 
1 so that the estimated mobile body position Xc will approach 
the target position X*. If the motor speed command generator 
8 can reduce the motor speed command to 0 (zero) at a 
predetermined fixed point, it is possible to control a stop 

25 position of the mobile body 4 . Thus , such a motor speed command 
generator 8 makes it possible to control the position of a 
mobile body without using a mobile body position detector. 
[0023] 
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Furthermore, a mobile body position indicator 9 inputs 
an estimated mobile body position Xc to create position 
information of a mobile body 4 and indicates the information. 
Such a mobile body position indicator 9 makes it possible to 
5 indicate a position of a mobile body without using a mobile 
body position detector. 
[0024] 

It is also possible to reduce the size of a mobile body 
system and save energy by using a permanent magnet-type 
10 synchronous motor as a synchronous motor 1. 
[0025] 

A power source which has rectified an alternate current 
by a rectifier circuit or a battery can be used as a DC power 
source 201. Further, the estimated rotor position quantity 

15 6mc can be calculated not only based on the output current from 
the power converter 202, but also based on output voltage, 
input DC current, or DC voltage. In this case, a detector for 
detecting those electrical quantities is mounted instead of 
a current detector 203 and a calculation method executed by 

2 0 a controller 3 including a rotor position estimator 301 is 
changed. Furthermore, in an embodiment shown in Figure 1, 
mobile body position information stored in a mobile body 
position estimator is corrected according to absolute position 
information of a mobile body by using position information 

25 correcting means. This can be applied to cases where the mobile 
body position is estimated from not only an estimated rotor 
position, but also from a detected value of the rotor position, 
or a detected or estimated value of the number of revolutions 
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of the rotor. 
[0026] 

Figure 2 illustrates a mobile body system which is a second 
embodiment of the present invention. In this embodiment, an 
5 elevator car 401 and a counter weight 402 are mobile bodies 
and a sheave 501 is drive means 5. The elevator car 401 and 
the counter weight 402 are driven by a synchronous motor 1 
via the sheave 501. Operations of other elements are the same 
as those that are explained in a first embodiment. This 
10 embodiment can detect and control the position of the elevator 
car 401 or the counter weight 402 without using a magnetic 
pole position detector of a synchronous motor 1 or a position 
detector for the elevator car 401 or the counter weight 402. 
[0027] 

15 When a motor is installed in the bottom or top of an elevator 

shaft as shown in the embodiment of Figure 2 and if a magnetic 
pole position detector is required, it becomes difficult to 
replace, mount, or adjust the magnetic pole position detector. 
This embodiment eliminates such a problem. 

20 [0028] 

Figure 3 illustrates a mobile body system which is a third 
embodiment of the present invention. In this embodiment, an 
elevator door 403 is a mobile body and a door drive unit 502 
is drive means 5. The elevator door 403 is driven by a 

25 synchronous motor 1 via the door drive unit 502. Operations 
of other elements are the same as those that are explained 
in a first embodiment. When the installation space is very 
small and limited, this embodiment increases equipment layout 
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space and saves installation space. 
[0029] 

If the embodiment shown in Figure 3 is applied to another 
door which is driven by a synchronous motor but is not an elevator 
5 door, the same effect can be expected. 
[0030] 

Figure 4 illustrates a mobile body system which is a fourth 
embodiment of the present invention. In this embodiment, a 
mobile body system is applied to a wheel chair compatible 

10 escalator wherein wheel chair compatible steps 404 are mobile 
bodies and step drive means 503 is drive means 5. Escalator 
steps including wheel chair compatible steps 404 are driven 
by a synchronous motor 1 via the step drive means 503. 
Operations of other elements are the same as those that are 

15 explained in a first embodiment. 
[0031] 

The wheel chair compatible escalator has a function that 
horizontally aligns at least two or three wheel chair compatible 
steps 404, among steps connected in a ring as shown in Figure 

20 4, at one location so that a wheel chair can be placed on those 
steps. For example, when a wheel chair request button is 
pressed, a controller of the wheel chair compatible escalator, 
i.e. a mobile body system, estimates the position of the wheel 
chair compatible steps 404 by using a mobile body position 

25 estimator 6 and stops the steps at the entrance of the escalator . 
This embodiment can detect the position of the steps without 
using a position detector which protrudes in the direction 
parallel to the steps. Consequently, it is possible to decrease 
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a width of the escalator thereby making the best use of space 
in a building where the escalator is installed. 
[0032] 

Figure 5 illustrates a mobile body system which is a fifth 
5 embodiment of the present invention. In this embodiment, 
rolling stock 405 is a mobile body and driving wheels 504 are 
drive means . Operations of other elements are the same as those 
that are explained in a first embodiment. A commonly-used 
conventional signal system can distinguish the presence of 

10 a train located in a given block section, however, it cannot 
detect the position of the train or the number of trains in 
the same block section. On the other hand, this embodiment 
can obtain position information of each train. Thus, it is 
possible to obtain position information of a plurality of trains 

15 which exist in a block section without employing an especially 
accurate position detector. As a result, high traffic density 
train running schedule becomes feasible. 
[0033] 

Figure 6 illustrates a mobile body system which is a sixth 
20 embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises a fixed point 
701 disposed in the traveling area of a mobile body 4, absolute 
position information providing means 702 which provides 
position information obtained when the mobile body 4 passes 
25 by the fixed point 701 as absolute position information, and 
information providing means 703 which inputs the absolute 
position information and outputs position information to 
correct absolute position information stored in a mobile body 
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position estimator 6. 
[0034] 

In the embodiment shown in Figure 6, if an error occurs 
in the position of the mobile body 4 estimated by the mobile 
5 body position estimator 6, the estimated position will be 
corrected by the following procedures. A plurality of fixed 
points 701 comprising metal shielding plates and the like are 
installed at specified positions, for example, in front of 
and at the back of the mobile body stop position. Absolute 

10 position information providing means 702 comprising of a 

positector or the like is placed on the mobile body side. The 
absolute position information providing means 702 accepts 
interrupt when it is opposed to the fixed point 701, reads 
out absolute position information which has been made into 

15 a table and overwrites position information stored in the mobile 
body position estimator 6. This makes it possible to 
consistently and accurately estimate the position of a mobile 
body when the mobile body passes by a specified position. This 
embodiment compensates for errors caused by slippery or 

20 worn-out drive means 5 . As a consequence, position estimation 
by a mobile body position estimator 6 becomes highly reliable 
and accurate. 
[0035] 

Figure 7 illustrates a mobile body system which is a seventh 
25 embodiment of the present invention. In this embodiment, 
correcting operation switching means 7 04 is added to the 
embodiment shown in Figure 6. When a mobile body position 
estimator 6 estimates that a mobile body 4 exists in the mobile 
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body existence detecting area which is a vicinity of a fixed 
point 701, the correcting operation switching means 704 accepts 
interrupt by absolute position information providing means 
702 which is opposed to the fixed point 701 and enables position 
5 information correcting operation via correction information 
providing means 703. This allows the absolute position 
information providing means 702 to operate only in the vicinity 
of the area where correcting operation is originally conducted . 
Accordingly, it is possible to reduce malfunction due to noise. 

10 [0036] 

Furthermore, in order to increase the accuracy of stopping 
a mobile body at a predetermined position, it is recommended 
that a fixed point 701, shown in Figure 6 and Figure 7, be 
installed at a position in front of each floor when a mobile 

15 body is an elevator car, at the fully opened or fully closed 
end when a mobile body is an elevator door, and at an entrance 
or an exit of an escalator when a mobile body system is a wheel 
chair compatible escalator. 
[0037] 

2 0 Figure 8 illustrates a mobile body system which is an eighth 

embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises a fixed point 
701, absolute position information providing means 702, 
correction information providing means 703 which outputs 

25 corrective position information so that a mobile body position 
estimator 6 can correct an estimated position, and initial 
position setting means 705 which outputs corrective position 
information at the initial state. 
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[0038] 

Next, an initial position setting operation by the 
embodiment shown in Figure 8 will be described. The value X0 
in Equation ( 1 ) is initially set when a system is activated 
5 by turning on the power. Specifically, after the power is 
turned on, a mobile body slowly travels to an end of the traveling 
range. After the initial absolute position information is 
obtained, the value X0 stored in a mobile body position estimator 
6 is initialized by initial position setting means 705. After 

10 that, in order to measure the position of a fixed point, a 
revolution is made at a speed that does not race the drive 
means. When position information which corresponds to the 
absolute position of each fixed point is obtained, settings 
of initial position information is completed. For example, 

15 when a mobile body is an elevator car or a counter weight, 
an initial position setting operation starts either at the 
top or bottom of an elevator shaft . When a mobile body is rolling 
stock, an initial position setting operation starts when a 
fixed point placed at an originating station is opposed to 

20 absolute position information providing means 702. This 

embodiment does not require designing and setting the absolute 
position of a plurality of fixed points beforehand and easily 
establishes a position information correcting system. 
[0039] 

25 Figure 9 illustrates a mobile body system which is a ninth 

embodiment of the present invention. In this embodiment, 
position information correcting means 7 comprises absolute 
position information providing means 702, correction 
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information providing means 703, correcting operation 
switching means 7 04, and a satellite 706. 
[0040] 

Operations of the embodiment shown in Figure 9 will be 
5 described in the following. Absolute position information 
providing means 702 obtains absolute position information from 
a satellite 706 and outputs the information. When a mobile 
body position estimator 6 estimates that a mobile body 4 has 
reached a predetermined point in the traveling area , correcting 

10 operation switching means 704 accepts absolute position 
information which is output by the absolute position 
information providing means 702 and enables position 
information correcting operation via correction information 
providing means 703. This embodiment can correct shifts of 

15 an estimated position obtained by the mobile body position 
estimator 6 without placing a fixed point in the mobile body 
traveling area. Further, a wireless station installed on the 
ground can be used instead of a satellite as means by which 
the absolute position information providing means obtains 

20 absolute position information. 
[0041] 

Moreover, as shown in any one of embodiments described 
above, a method of correcting a mobile body position estimated 
by a mobile body position estimator based on absolute position 
25 information of a mobile body or setting the initial value of 
a mobile body position can be applied to cases where a mobile 
body position is estimated not only from an estimated rotor 
position, but also from a detected value of a rotor position, 



or a detected or estimated value of the number of revolutions 
of the rotor. 
[0042] 

The present invention can detect a position of a mobile 
body without using a mobile body position detector. Further, 
correcting an estimated position of a mobile body by using 
absolute position information increases the accuracy and 
reliability of mobile body position estimation. 



